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Terminal  guidance  of  a  hypervelocity  exoatmospheric  orbital  interceptor  with  free  end  time  is  examined.  A 
new  approach  called  certainty  control  is  developed  where  control  energy  expenditure  is  reduced  by  constraining 
the  expected  final  state  to  a  function  of  projected  estimate  error.  Conceptually,  the  constraint  produces  a 
shrinking  sphere  about  the  predicted  impact  point  with  the  radius  being  a  function  of  estimated  error.  If  the 
predicted  miss  is  inside  or  touching  the  sphere,  thrusting  is  not  necessary.  The  interceptor  is  modeled  as  a 
satellite  with  lateral  thrusting  capability  using  two-body  orbital  dynamics.  The  target  is  modeled  as  an 
intercontinental  ballistic  missile  (IBM)  in  its  final  boost  phase  prior  to  burnout.  Filtering  is  accomplished  using 
an  eight-state  extended  Kalman  filter  with  line-of-sight  and  range  updates.  The  estimated  relative  trajectory  and 
variances  are  propagated  numerically  to  predicted  impact  time  and  then  approximated  by  splines,  eliminating 
the  need  to  propagate  new  data  repeatedly  when  present  conditions  are  varied.  A  search  is  then  made  for  a 
new  impact  time  and  point  that  will  minimize  present  interceptor  velocity  changes  and  final  miss  distance. 

This  control  strategy,  which  is  applied  to  two  intercept  problems,  substantially  reduces  fuel  consumption. 
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Terminal  guidance  of  a  hypervelocity  exoatmospheric  orbital  interceptor  with  free  end  time  is  examined.  A 
new  approach  called  certainty  control  is  developed  where  control  energy  expenditure  is  reduced  by  constraining 
the  expected  final  state  to  a  function  of  projected  estimate  error.  Conceptually,  the  constraint  produces  a 
shrinking  sphere  about  the  predicted  impact  point  with  the  radius  being  a  function  of  estimated  error.  If  the 
predicted  miss  is  inside  or  touching  the  sphere,  thrusting  is  not  necessary.  The  interceptor  is  modeled  as  a  satellite 
with  lateral  thrusting  capability  using  two-body  orbital  dynamics.  The  target  is  modeled  as  an  intercontinental 
ballistic  missile  (IBM)  in  its  final  boost  phase  prior  to  burnout.  Filtering  is  accomplished  using  an  eight-state 
extended  Kalman  filter  with  line-of-sight  and  range  updates.  The  estimated  relative  trajectory  and  variances  are 
propagated  numerically  to  predicted  impact  time  and  then  approximated  by  splines,  eliminating  tbe  need  to 
propagate  new  data  repeatedly  when  present  conditions  are  varied.  A  search  is  then  made  for  a  new  impact  time 
and  point  that  will  minimize  present  interceptor  velocity  changes  and  final  miss  distance.  This  control  strategy, 
which  is  applied  to  two  intercept  problems,  substantially  reduces  fuel  consumption. 


A 

Nomenclature 

=  present  acceleration,  m/s2 

A  o 

=  initial  acceleration,  m/s2 

A  ,B,C,D 

coefficients  of  splines  (A,  m/s3:  B,  m/s2;  C, 

a,, a. 

m/s;  D,  m) 

=  lateral  thrust  accelerations,  m/s3 

dA  Vy 

=  differential  change  in  velocity  change 

E 

=  expected  value  operator 

f 

=  scalar  cost  function 

Gxi 

=  uncertainty  in  final  state 

H 

=  Hamiltonian,  =  cost  function  +  constraint 

J 

adjoined  via  Lagrangian  multiplier 
=  Jacobian  matrix  of  /vector 

K 

=  constraint  weighting  factor 

L 

cost  function 

m0 

=  initial  mass  flow  rate  divided  by  mass,  s* 1 

R 

=  relative  range,  m 

t 

=  current  time,  s 

lv> 

=  time  to  go,  s 

V 

=  relative  velocity,  m/s 

Xf 

=  final  state 

x, 

=  predicted  final  state  without  control  update 

x.y.Zi.r 

using  splines 

=  x,  y,  z  coordinate  positions  for  interceptor 

A  Vy  ,A  V. 

and  target,  m 

=  interceptor’s  velocity  changes,  m/s 

X 

*  Lagrangian  multiplier 

M 

=  Earth’s  gravitational  constant 

a 

=  standard  deviation 

Superscripts 

O 

*  denotes  best  estimate 

(  > 

=  denotes  the  first  derivative  with  respect  to  time 
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(')  =  denotes  the  second  derivative  with  respect  to 

time 


Introduction 

NTERCEPTOR  performance  can  be  enhanced  by  using  a 
terminal  guidance  law  that  incorporates  the  dynamics  of 
the  interceptor  and  target  plus  the  error  knowledge  of  their 
estimates.  This  paper  develops  a  guidance  scheme  that 
minimizes  lateral  thrusting  for  a  hypervelocity,  exoatmos¬ 
pheric  orbital  vehicle  in  the  final  30  s  of  flight  while  it  is 
attempting  to  intercept  a  boosting  missile. 

Much  work  has  been  done  in  the  area  of  air-to-air  guidance 
that  has  space-to-space  application.  Guelman1-2  has  derived  a 
closed-form  solution  for  pure  proportional  navigation.  Singu¬ 
lar  perturbation  methods  have  been  employed  by  Sridhar  and 
Gupta3  for  air-to-air  guidance.  Design  procedures  using  opti¬ 
mal  and  stochastic  control  techniques  abound.1'14  In  the 
works  just  cited,  the  force  of  gravity  is  assumed  to  act  equally 
or  the  interceptor  and  target  and  is  ignored  in  the  relative 
dynamics.  This  flat-Earth  assumption  is  adequate  for  air-to- 
air  encounters,  but  not  for  space-to-space,  except  at  short 
ranges.  For  orbital  intercepts  with  large  initial  ranges,  the 
force  of  gravity  will  affect  the  relative  trajectory  and  should  be 
included  in  the  equations  of  motion. 

The  literature  for  space-to-space  guidance  reveals  many  nu¬ 
merical  approaches  for  determining  present  velocity  for  future 
rendezvous.15*21  To  date,  analytic  solutions  for  such  intercepts 
exist  only  when  the  interceptor’s  impact  conditions  are  pre¬ 
specified. ”  These  works  do  not  address  hypervelocity  inter¬ 
cept  involving  seconds,  but  are  concerned  with  a  much  slower 
rendezvous  process  involving  hours  or  even  days. 

The  guidance  scheme  presented  here  attempts  to  minimize 
lateral  velocity  changes  by  varying  the  impact  conditions 
through  the  use  of  splines.  Splines  were  used  by  Johnson14  in 
presenting  a  possible  Earth-Mars  transfer  guidance  algorithm. 
Dickmanns  and  Weils,23  as  well  as  Hargraves  and  Paris,33  have 
used  third-order  polynomials  for  general  trajectory  optimiza¬ 
tion.  The  splines  result  in  faster  searches  by  eliminating  the 
need  to  propagate  new  trajectories  repeatedly  when  conditions 
are  varied.  This  feature  makes  them  attractive  for  a  hyperve- 
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'ocity  orbital  intercept  that  requires  a  fast  and  reasonably 
accurate  numerical  search. 

Target  tracking  is  accomplished  with  a  ranging  device  and 
'ne-of-sight  sensors  for  in-plane  and  out-of-plane  measure¬ 
ments.  Noise-corrupted  data  is  processed  through  an  extended 
Kalman  filter  (EKF)  with  serial  updates  occurring  every  0.1  s. 

3v  constraining  the  estimated  final  state  to  a  function  of  the 
projected  estimate  error,  much  needless  thrusting  can  be  elim- 
.nated  in  the  presence  of  poor  estimates.  This  strategy  can 
substantially  reduce  the  fuel  consumption  needed  for  inter¬ 
cepts. 


System  Modeling 

Here,  the  equations  of  motion  for  the  target  and  interceptor 
are  developed.  Atmospheric  drag  will  not  be  considered  in  the 
dynamics  because  the  interceptor  is  assumed  exoatmospheric. 
Also,  due  to  the  interceptor’s  lateral  thrusting  limitation,  the 
longitudinal  axis  will  be  assumed  to  be  parallel  to  the  intercep¬ 
tor’s  initial  velocity  vector. 

The  interceptor  is  modeled  as  a  satellite  traveling  in  excess 
of  12  km/s  with  lateral  thrusting  capability  using  two-body 
orbital  dynamics.  Thrusting  is  prohibited  along  the  longitudi¬ 
nal  (x)  axis  in  the  forward  direction  to  prevent  sensor  contam¬ 
ination  and  in  the  rearward  direction  because  of  the  large  aft 
booster  necessary  to  achieve  hypervelocity  speed.  The  equa¬ 
tions  of  motion  are  as  follows: 


-  U  X, 

(l) 

v  ■> 

(xj  +z;r- 

-  »  yr 

(2) 

'  (x'r  +  y'i  +  zr)3'2  a" 

~  (XJ  +  yj  +z})3n  +°z 

(3) 

The  target  is  modeled  as  an  intercontinental  ballistic  missile 
( ICBM)  in  its  final  boost  phase  using  two-body  orbital  dynam¬ 
ics.  For  tracking  purposes,  the  intercept  must  occur  prior  to 
burnout.  Acceleration  due  to  thrusting  is  computed  in  the 
direction  of  the  ICBM’s  velocity  vector.  The  equations  of 
motion  are 


A  =- - — 

1  -*o/ 

(4) 

XT  = 

-H  xr  A  xT 

(5) 

(x'r  +  y'f  +  z'f)3'1  *  (*  f  +  y t  + 

yr  = 

-nyT  AyT 

(6) 

ix'r  +y?  +  z'r)3'2  '  (*>  +  >r  +  ir)'n 

Zr  = 

~  u  Zr  j  A  Zr 

(7) 

(x:t  +•>-?  +  Zf)3/2  (x:T  +  y\  +  zf)l/: 

Problem  Statement  and  Truth  Model 

Time-to-go  and  interceptor  velocity  changes  are  the  control 
parameters  that  must  be  varied  to  minimize  miss  distance  and 
fuel  expended  (i.e.,  velocity  changes).  The  mathematical  rep¬ 
resentation  of  this  control  objective  is  presented  in  the  section 
on  certainty  control,  which  follows.  Miss  distance  is  deter¬ 
mined  by  establishing  a  Mme  remaining  until  intercept  (time  to 
go)  and  propagating  the  equations  of  motion  forward.  An 
iterative  process  can  then  be  used  to  find  the  interceptor 
velocity  needed  to  bring  the  miss  distance  to  zero.  The  differ¬ 
ence  between  current  velocity  and  that  needed  for  intercept, 
known  as  velocity  to  go,  must  be  minimized.  To  accomplish 
this,  the  time  to  go  is  varied  and  the  procedure  just  mentioned 
is  repeated  until  a  minimum  velocity  to  go  is  found. 

The  computation  of  needed  velocity  is  time  consuming  be¬ 
cause  the  equations  of  motion  are  nonlinear  and  do  not  lend 


themselves  to  closed-form  solution.  These  equations  must  be 
propagated  numerically  to  intercept  time  whenever  the  initial 
velocity  is  varied.  The  previous  method  will  serve  as  the  basis 
(truth)  model  for  this  control  problem  using  the  numerical 
techniques  found  in  Maron.:i 

A  Newton-Raphson  method  for  solving  nonlinear  systems  is 
employed  to  determine  the  proper  values  of  the  control 
parameters.  Let 


AP, 

A  V. 

tgo 


(8) 


be  a  solution  of  the  nonlinear  system 


Mu) 

*rU*o)  -*7(^go) 

0 

Mu) 

yrUto)  ~~  y o) 

= 

0 

Mu) 

0 

The  effect  of  small  velocity  changes  in  Eq.  (9)  can  be  consid¬ 
ered  linear  because  the  interceptor  is  assumed  to  travel  at 
hypervelocity,  resulting  in  a  near  straight-line  traj*ctory.  Any 
error  caused  by  this  assumption  will  be  accounted  for  in  the 
succeeding  iteration  when  the  proposed  velocity  change  is 
incorporated  in  the  nonlinear  dynamics. 

The  initial  control  values  must  be  incrementally  changed  to 
satisfy  Eq.  (9).  A  linear  approximation  of  the  /  vector  for 
changes  in  u  will  yield  approximate  increments  of  the  control 
parameters.  The  linearized  system  becomes 


/.(«) 

l/l 

dAKj 

=  - 

/:(«) 

d/|0 

Mu) 

i 


i 


where  /  is  the  Jacobian  matrix  of  the  /vector  evaluated  at  u: 


[/]  = 


0  0  lxr(',o)--Mt|o)l 

“  tjo  0  I  JVrltgo)  j’/ltfo)  A  Vy  1 
0  —  fgo  I  vr(fgo) —  Zi(tgo)  “*  A  k’.  1 


(U) 


To  determine  changes  in  the  u  vector,  f  is  multiplied  by  the 
negative  inverse  of  / 


/i(u) 

dAK 

=  -[/]-' 

/:(«) 

df,o 

Mu) 

. 

. 

(12) 


Aoonssion  For 
a 


L.r  - '  = 


yrd^-ytUto)-  au,  - 1 


1  itr(tjo)  X/  ( tj0) )  tj0 
C  r(t|o)  —  tf(t|o)  ~  A 
I  jo)  “  X/(/|0)  )  tj0 

_ I _ 

I  xr(f|o)  ~  ^(/«)  | 


-  1 


(13) 


To  find  the  control  parameters,  the  following  procedure 
should  be  used.  First,  establish  a  time  to  go  with  zero  velocity 
changes,  a  good  choice  being  the  time  to  go  that  yields  the 
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point  of  closest  approach.  This  time  to  go  is  determined  by 
propagating  the  orbits  forward  until  a  minimum  relative  dis¬ 
tance  is  reached.  Because  the  target  is  assumed  to  be  in  its  final 
boost  phase  throughout  the  intercept,  this  time  to  go  will  be 
less  than  or  equal  to  the  time  until  ICBM  thrust  termination. 
Second,  propagate  the  dynamic  equations  (Eqs.  (1-7)1  for¬ 
ward  to  the  intercept  time  and  determine  the/vector  from  Eq. 
(9).  Changes  to  the  control  parameters  are  then  obtained  from 
Eq.  (12).  The  velocity  changes  are  applied  to  the  interceptor’s 
initial  conditions  and  the  procedure  is  repeated  with  the  up¬ 
dated  time  to  go  until  convergence  occurs.  The  resulting  con¬ 
trol  parameters  will  drive  the  miss  distance  to  zero  with  mini¬ 
mum  velocity  changes.  The  difference  between  needed  and 
present  velocity  are  sufficient  to  determine  the  interceptor’s 
thrust  profile. 


Spline  Approximations 

As  discussed  earlier,  numerical  propagation  of  the  dynamic 
equations  is  very  time  consuming.  It  is  convenient  to  approxi¬ 
mate  the  relative  'rajectorv  by  a  polynomial,  eliminating  the 
need  for  repeated  propagation.  Cubic  splines  lend  themselves 
well  to  this  application. 16--  u  The  current  and  final  states  can 
be  used  to  generate  cubic  splines  along  each  axis  of  the  form 

x(t)  =  At1  +  Bt1  +  Ct  +  D  (14) 

By  setting  t  to  zero,  D  and  C  become  the  current  position 
and  velocity,  respectively,  with  time  to  go  being  the  intercept 
time.  Changes  in  velocity  will  be  reflected  only  in  the  C  coef¬ 
ficient,  and  the  final  state  can  be  determined  easily  for  any 
intercept  time.  With  this  formulation,  the  determination  of 
the  spline  coefficients  is  relatively  simple.  The  current  state  [let 
r  =  0  in  Eq.  (14)]  gives  D  and  C  with  no  computations 


D  =  x(o ) 

05) 

C  =  Mo) 

(16) 

The  A  and  B  coefficients  can  be  computed  using  the  final 
states  and  Eq.  (14)  as  follows: 

x(f,0)  =  At}0  +  B['a  +  Crto  +  D  (17) 

x(f,0)  =  3  A  tj0  +  2B!ia  +  C  (18) 


Because  there  are  only  two  unknowns  in  Eqs.  (17)  and  (18), 
algebraic  manipulation  yields 


_  2 (x(o)-x(/,0)]  [Mo)  +  xjtf0)] 

ft  ft 

‘|0  *»0 

B  =  3(*(<to)-*(o)l  [2 Ao)  +  trir,0)l 


(19) 


(20) 


There  is  an  added  versatility  in  using  splines.  Should  the 
system  model  be  changed,  only  the  spline  coefficients  need  be 
changed.  A  search  algorithm  based  on  the  splines  will  remain 
the  same,  operating  with  the  new  coefficients.  This  is  very 
beneficial  because  recomputing  the  coefficients  is  far  simpler 
than  altering  an  algorithm. 

To  ensure  accuracy,  new  spline  coefficients  are  computed 
every  cycle  time.  To  accomplish  this,  the  truth  model  is  prop¬ 
agated  forward  to  the  predicted  impact  time  to  obtain  the 
needed  final  states.  By  using  these  updated  final  states  every 
iteration,  propagated  roundoff  error  is  eliminated  in  the  spline 
coefficient  computations. 


Certainty  Control 

If  the  controls  associated  with  cost  do  not  affect  state  esti¬ 
mate  certainty,  fuel  may  be  conserved  by  using  that  certainty 
to  reduce  the  controls.  By  linking  the  controls  to  the  certainly 
of  the  estimate,  a  near  perfect  estimate  would  yield  the  opti¬ 


mal  control,  with  reduced  control  resulting  from  a  poor  esti¬ 
mate.  To  accomplish  this,  the  predicted  final  states  are  con¬ 
strained  by  a  function  of  their  variances  at  the  final  time.  This 
form  of  control  will  be  called  certainty  control  and  is  imple¬ 
mented  by  establishing  the  cost  function 

iK!  +  \V: 

- ~  v.21) 

subject  to  the  constraint: 

fJ}  +9}+i}-K\a\/  +  a-f  +  o\f)  ^ 

The  final  state  estimates  0 if,  yj ,  if)  and  their  deviations  ( axf , 
aw/,  a.j)  are  determined  by  running  the  filter  (Appendix  A) 
forward  to  predicted  impact  time  without  measurement  or 
control  updates  and  then  representing  their  time  history  with 
splines: 


Xs  —  ^Vgo  ’*■ 

(23) 

ys  -  sly! jo  +  By* go  +  Cyt go  +  &y 

(24) 

Zs  =  s\:ij0  4-  Bzt  “0  4-  C:/JO  +  D: 

(25) 

Xf=xs 

(26) 

yf  =  yt-±Vyt go 

(27) 

Zf  —  Zt  —  &  ^Vgo 

(28) 

®xf  =  si  ax!  go  ***  Ba*!ga  Cox!  go  "**  &  ox 

(29) 

Oyf  —  ^  ay! go  Boy! go  Caytg o  4*  &oy 

(30) 

°zf  “  sloz! jo  BaztgQ  4-  C„-/go  4-  Daz 

(31) 

Conceptually,  the  constraint  produces  a  deviation  sphere 
about  the  predicted  impact  point.  If  the  predicted  miss  is 
inside  or  touching  the  sphere,  thrusting  is  not  necessary.  If  the 
predicted  miss  is  outside  the  sphere,  minimum  thrusting  is 
determined  to  bring  the  miss  to  the  surface  of  the  sphere.  As 
the  estimates  improve,  the  constraint  tightens  and  the  sphere 
shrinks.  The  spline  representations  allow  this  stochastic  prob¬ 
lem  to  be  solved  deterministically.  The  constraint  is  adjoined 
via  a  Lagrange  multiplier  to  the  cost  function  to  form  the 
Hamiltonian25 

H  *  L  +  \f 

(32) 

To  minimize  the  cost  L  while  satisfying  the  constraint  /,  the 
partials  of  H  with  respect  to  the  controls  must  equal  zero 

dH 

3AK,  X^  =  ° 

(33) 

„ 

(34) 

dH  ...  , 

—  -  Uifif  +  yjyf  +  t/ if  -  K  K/<v 

v*|0 

+  Oyfdyf  +  a.f<J.f\)  =  0 

(35) 

with  the  dot  term  expansions  computed  in  Appendix  B. 

Equations  (22),  (33),  (34),  and  (35)  constitute  four  equa¬ 
tions  with  four  unknowns,  which  can  be  reduced  to  two  equa¬ 
tions  and  two  unknowns  using  Eqs.  (27)  and  (28).  Substituting 
Eq.  (27)  into  Eq.  (33)  yields 


W 

I  -t -X/J, 


(36) 
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9t  = 


y, 

1  +  Xt‘„ 


8)  Now  advance  one  time  step.  Propagate  and  update  the 
EKF  with  the  next  set  of  sensor  observations  and  return  to  step 
1  of  this  algorithm. 


In  a  similar  manner,  substituting  Eq.  (28)  into  Eq.  (34)  yields 


.  I / 

;  1  +  Xr50 

(38) 

!  1  +  Xr* 

(39) 

Equations  (22)  and  (35)  can  now  be  solved  in  terms  of  X  and 
•jj.  Once  known,  4k,  and  4k.  can  be  determined  from  Eqs. 
36)  and  (38).  The  parameters  X  and  rg0  can  be  found  by 
numerical  techniques  using  the  Jacobian 


dfgo 

- 

.  +  9}  -  ij  ~  a)/  +  a -:J] 

- - - - — - - - - -  (41) 

/:  =  xjf  +  y,yf  +  ifZf  -  K  [oXJbxf  +  o,fby/  +•  o.jb.j]  (42) 


Computer  Simulation 

Two  cases  are  examined  with  time  to  go  equaling  30  s.  Case 

1  represents  a  head-on,  '0-deg  out-of-plane  intercept,  and  case 

2  represents  a  10-deg  out-of-plane  tail  chase.  The  interceptor  is 
initially  traveling  at  12  km/s  at  an  altitude  of  7S0  km  with  a 
lateral  acceleration  range  of  3-60  m/s:  in  each  axis.  The 
booster’s  initial  acceleration  is  3.15788  m/s:  with  a  unitized 
mass  flow  rate  of  0.01579  s-1. 

A  time  lag  of  0.1  s  is  used  for  all  algorithms  when  comput¬ 
ing  velocity  changes.  It  is  unrealistic  to  assume  that  the  filter 
can  process  measurements,  the  controller  determine  thrust 
commands,  and  the  thrusters  respond  to  those  commands  all 
instantaneously.  One  cycle  time  is  chosen  to  allow  the  velocity 
changes  computed  in  the  previous  cycle  to  be  implemented  in 
the  present  cycle.  The  controller  routines  are  built  to  take  this 
lag  into  account.  Also,  thrusting  is  not  permitted  during  the 
first  3  s  of  an  intercept  to  account  for  target  acquisition.  This 
simulation,  written  in  Fortran  77  to  run  on  a  Vax  8600, 
generates  100  Monte  Carlo  runs  per  case. 


■■Mth  the  elements  of  the  Jacobian  matrix  computed  in  Ap¬ 
pendix  B. 

Should  the  states  be  perfectly  known,  the  a  terms  will  be 
zero.  In  this  case,  the  equations  for  certainty  control  reduce  to 
hose  of  optimal  control  formulation.  Should  the  estimate  be 
poor,  the  a  terms  will  be  large  and  the  inequality  constraint  of 
Eq.  (22)  is  met  with  very  little  (if  any)  change  in  velocity.  This 
demonstrates  the  principle  of  certainty  control,  where  the 
certainty  of  the  estimate  affects  control  energy  expenditure 


Results 

Seven  algorithms  were  programmed  to  serve  as  a  basis  of 
comparison  with  the  certainty  control  algorithm.  Plan  A  uses 
the  cost  function  incorporating  velocity  changes  and  miss 
distance  weighted  by  a  weighting  factor  K  (X-  =  10  for  this 
simulation). 

X  f+yf+Zf  4  k;  vAk; 

L= - 2 — '  +  ~~1 —  (43) 


Algorithm 

1)  Propagate  EKF  forward  one  time  step  without  measure¬ 
ment  or  control  updates  and  get  new  state  estimates,  jf(0),  and 
variances,  6(0),  for  next  time  step.  Use  the  secant  method  to 
approximate  .£(0)  and  b(0). 

2)  Reset  r,„  to  (r|O-0. 1)  to  account  for  advanced  step  from 
step  1  (this  paper  uses  a  time  step  of  0.1  s). 

3)  PropagateEKF  forward  to  intercept  time  (r,0)  without 
updates  to  get  ■?(/,„)  and  b(t>a). 

4)  Reset  EKF  to  current  time. 

5)  Determine  the  spline  equations  for  Z(()  and  b(t)  using  the 
data  from  steps  1  and  3. 

6)  Determine  the  lateral  velocity  changes  and  new  intercept 
time  using  certainty  control.  In  other  words,  minimize 


Plan  B  uses  the  same  loss  function  but  with  a  =  °o,  a  zero 
miss  solution.  Plan  C  uses  a  proportional  navigation  scheme 
recognizing  that  the  velocity  vector  on  the  target  is  changing. 

The  next  plan  is  an  optimal  spacing  algorithm  where  control 
is  applied  based  on  control  effectiveness. Corrective  thrust¬ 
ing  is  applied  when  the  control  has  (1  /p)  the  effect  of  the 
previous  corrective  thrust.  A  value  of  p  =  1.75  was  determined 
during  the  simulation  of  plan  B  to  be  the  best  value.  The  dual 
control  algorithm5  minimizes  the  expected  value  of  Eq.  (43)  or 


E\L  1  =K 


T>/ ' 


*} 


■ y. 7 


+  E 


A  V)  +  .*  v\ 
2  . 


(44) 


subject  to  the  constraint 

/  _  +  -  X[<Tr/;gr/  +  j^:l  s0 

where  the  subscript  /  denotes  the  final  state  at  the  new  inter¬ 
cept  time.  (It  is  not  necessary  to  use  splines  to  do  this  step.  We 
chose  splines  to  reduce  computational  burdens  and  allow  a 
solution  that  lends  itself  to  deterministic  techniques.  The  esti¬ 
mates  and  variances  in  the  constraint  equation  make  this 
problem  stochastic,  but  by  approximating  them  with  spline 
equations  where  time  becomes  a  variable,  a  deterministic  ap¬ 
proach  to  the  solution  can  be  used.) 

7)  Reset  f,„  to  the  new  intercept  time  and  apply  the  velocity 
changes  from  step  6.  If  the  velocity  change  in  a  given  axis  is 
below  the  minimum  threshold,  then  do  not  apply  the  com¬ 
puted  in  that  axis.  Minimum  threshold  for  this  paper  was 
0.3  m/s  (3.0  m/s:  x  O.ls  time  step).  Maximum  AV  for  any 
axis  is  60  m/s5.  If  4k exceeds  this  limit,  it  is  reset  to  the  limit. 


Table  1.  Case  t  performance  head-on, 
10-deg  out-of-plane  intercept 


Mean 
miss,  m 

Standard 
deviation,  m 

Mean 
AV.  m/s 

Standard 
deviation,  m/s 

Plan  A,  K  =  10 
(CE  optimal) 

0.502 

0.224 

83.82 

6.99 

Plan  B,  K  =  « 
(CE  optimal) 

0.360 

0.171 

90.39 

7.24 

Plan  C 

(PRO  NAV)» 

0.360 

0.171 

93.07 

7.39 

Optimum 
spacing,  p  = 
1.75 

0.361 

0.171 

37.19 

8.50 

Dual  control, 

K  -  10 

0.501 

0.224 

83.82 

6.99 

Certainty 

control. 

K  -0.4 

0.386 

0.191 

23.21 

4.18 

Truih  w»ih 
nots* 

0.545 

0.264 

83.69 

7.18 

Truth  without 
noise 

0 

na 

7.54 

na 

‘Proportional  navigation. 
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The  next  algorithm  is  that  of  certainty  control  presented  in 
this  paper.  The  last  two  are  truth  models  with  and  without 
noise.  The  performance  of  the  truth  model  vs  the  various 
algorithms  is  recorded  in  Tables  1  and  2. 

The  data  indicates  the  dual  control’s  performance  is  no 
better  than  the  certainty  equivalence  formulation  of  plan  A. 
This  is  due  to  the  fact  that  range  is  included  as  a  measurement, 
causing  the  control  to  have  virtually  no  effect  on  improving 
filter  variance.  Plan  B  is  more  accurate  than  plan  A,  but  more 
costly  in  energy.  Again,  this  result  is  expected  because  the 
formulation  of  plan  B  is  based  on  infinite  miss  penalty 
(K  =  °o)  for  plan  A.  By  optimally  spacing  the  thrusts  of  plan 
B,  energy  expenditure  is  considerably  reduced  with  little  or  no 
sacrifice  in  accuracy. 


Table  2.  Case  2  performance 
10-deg  out-of-plane  tail  chase 


Mean 
miss,  m 

Standard 
deviation,  m 

Mean 
41',  m/s 

Standard 
deviation,  m/s 

Plan  A.  K  =  10 

0.190 

0.100 

129.61 

13.29 

(CE  optimal) 
Plan  B,  /f  =  » 

0.126 

0.061 

132.65 

13.32 

(CE  optimal) 
Plan  C 

0.126 

0.061 

129.47 

12.26 

(PRO  NAV)» 
Optimum 

0.126 

0.059 

39.96 

12.85 

spacing.  p  = 
1.75 

Dual  control, 

0.190 

0.100 

129.61 

13.29 

K  =  10 
Certainty 

0.136 

0.076 

29.74 

9.10 

control. 

A' =0.4 

Truth  with 

0.379 

0.204 

123.57 

11.61 

noise 

Truth  without 

0 

na 

9.52 

na 

noise 

•Proportional  navigation. 


Plan  C  is  just  as  accurate  as  plan  B,  with  slightly  greater  cost 
resulting  from  large  initial  intercept  range.  This  extra  cost  is 
attributed  to  the  negligible  gravity  assumption  used  in  the 
formulation  of  plan  C.  For  the  smaller  ranges  associated  with 
a  tail  chase,  plan  C  was  actually  less  costly  than  plan  B. 

s-o  I  I  1 


0.0  10.0  20.0  30.0 

TIME.  (SEC) 

Fig.  2  In-plane  thrust  profile  of  truth  model  for  case  2. 


I  l.'IE.  1  Itv,  ) 

Fig.  I  In-plane  thrust  profile  of  truth  model  for  case  I.  Fig.  3  In-plane  thrust  profile  of  certainly  control  for  case  I. 
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0.0  10.0  20. a  30.0 

TIME  (SEC) 

Fig.  4  In-plane  thrust  profile  of  certainty  control  for  case  2. 


The  effect  of  estimate  uncertainty  can  be  observed  from  the 
truth  model  in-plane  thrust  profiles  (Figs.  I  and  2).  This 
uncertainty  causes  needless  and  often  counterproductive 
thrusting.  In  contrast,  certainty  control  requires  considerably 
less  energy  expenditure  (Figs.  3  and  4).  This  result  is  not 
surprising,  as  the  formulation  of  certainty  control  is  based  on 
reducing  control  energy  in  the  presence  of  poor  estimates.  This 
form  of  control  works  well  because  filter  variance  is  range 
dependent.  As  range  decreases,  the  control  constraint  tightens 
and  accuracy  increases.  Therefore,  less  fuel  is  used  when  range 
is  great  and  estimates  are  poor,  with  refinements  made  as 
impact  nears. 


Conclusions 

In  this  paper,  six  guidance  schemes  were  examined  to  deter¬ 
mine  their  capability  to  minimize  lateral  velocity  changes  of  a 
hypervelocity  orbital  intercept  vehicle.  Optimal  control  using 
certainty  equivalence  (plans  A  and  B),  proportional  naviga¬ 
tion  (plan  C),  control  with  optimum  thrust  spacing,  dual 
control,  and  certainty  control  were  all  implemented  for  two 
cases. 

Certainty  control  can  be  effective  in  reducing  energy  expen¬ 
diture  when  the  controls  associated  with  cost  do  not  affect 
state  estimate  certainty.  If  the  controls  can  improve  the  esti¬ 
mate,  then  dual  control  techniques  may  be  more  effective  in 
reducing  cost.  Because  range  is  included  as  a  measurement, 
lateral  deviations  do  not  noticeably  improve  the  estimate, 
allowing  certainty  control  to  significantly  reduce  thrusting. 

Certainty  control  contrains  the  final  condition  to  a  function 
of  final  estimator  accuracy  in  the  absence  of  updates.  This 
general  approach  is  not  limited  to  hypervelocity  vehicles  and 
would  suggest  other  applications  of  this  form  to  control  inter¬ 
cepts  stochastically. 

Dual  control  requires  a  measure  of  final  estimator  accuracy, 
which  was  achieved  by  running  the  extended  Kalman  filter 
forward  to  intercept  time  without  updates.  This  time-consum¬ 
ing  process  could  be  eliminated  if  filter  variances  could  be 


estimated  by  some  function  (polynomial  or  otherwise).  Also, 
the  constraint  multiplier  was  assumed  constant  for  this  formu¬ 
lation.  A  future  area  of  research  is  to  develop  a  multiplier  that 
is  range  or  time  dependent  to  further  reduce  interceptor 
thrusting. 

In  summary,  the  approach  identified  by  this  research  not 
only  improves  the  efficiency  of  hypervelocity  intercept,  but 
can  be  applied  to  a  broad  range  of  stochastic  problems  where 
control  energy  does  not  improve  filter  accuracy.  It  is  also 
possible  to  combine  the  effects  of  dual  and  certainty  control  in 
certain  cases  by  initially  using  dual  control  to  improve  estima¬ 
tor  accuracy  and  then  switching  to  certainty  control.  Endgame 
accuracy  may  be  improved  by  switching  from  certainty  control 
to  a  certainty  equivalence  formulation  just  prior  to  impact. 


Appendix  A:  Extended  Kalman  Filtering 

Optimal  estimates  of  the  interceptor  and  target  are  needed 
for  the  search  algorithms  to  converge  properly.  Because  of  the 
nature  of  the  dynamics  and  sensors,  the  relative  position  and 
velocity  must  be  estimated  from  sampled  nonlinear  measure¬ 
ments.  The  estimation  problem  for  a  nonlinear  system  having 
continuous  dynamics  and  discrete-time  measurements  is  ad¬ 
dressed  by  Gelb.36  The  EKF  was  chosen  over  other  estimation 
methods  because  the  optimal  estimate  is  determinate.  That  is, 
the  dynamics  and  observations  of  the  interceptor  and  target 
can  be  well  predicted  in  the  presence  of  Gaussian  noise.  The 
EKF  states  are  defined  from  Eqs.  (5-11)  as  follows: 


x,=xT-x, 

(Al) 

XZ=XT-X, 

(A2) 

1 

k- 

II 

H 

(A3) 

xt=yT-yi 

(A4) 

X^-Zt—Zj 

(A5) 

Xi  =  ZT-Zl 

(A6) 

Xi  =  A 

(A7) 

xs  =  m 

(A8) 

The  measurements  of  range  and  LOS  angles  are 

Zi(A-)  =  Vxf  +x;+xf+  VR(k)  (A9) 

Zi(k)  =  tan  -  '(x</jr,)  +  V^k)  (A10) 

zJ(*)  =  tan-|(x-J/x-,)+  VR(k)  (All) 

It  is  advantageous  to  process  measurements  one  at  a  time. 
This  method,  called  serial  updating, :7  eliminates  the  require¬ 
ment  to  compute  a  matrix  inverse,  thereby  reducing  computer 
load  and  avoiding  the  computational  problems  associated  with 
inverting  an  ill-conditioned  matrix.  Also,  measurements  may 
be  skipped  without  reformulating  the  filter  equations,  allow¬ 
ing  greater  flexibility  in  examining  various  tracking  schemes. 
The  simultaneous  components  of  the  measurement  vector 
can  be  considered  serially  over  a  very  short  time  span.  The 
propagation  noise  w  stems  from  using  a  fourth-order  Runge- 
Kutta  integrator  with  updates  every  0.1  s  on  a  64-bit  word. 

‘•’*.,.£(0-^(0.2.21516  x  10""  nr/s) 

*v».,.£(O~/V(0,  5.52049  x  I0"“mVsJ) 

waU)~N{0,  4.29831  x  10-,2  mVs5) 

w*(0  — N(0.  2.493241  x  10"’  l/sJ) 
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In  all  cases,  the  measurement  v  noise  properties  associated 
with  the  filter  are 

Ve,y(k)-N(Q,  1.0  x  10' !) 

V*(k)-N( 0,  1.0  x  10'*  x  R2m2) 

where  8  is  the  out-of-plane,  line-of-sight  angle,  y  the  in-plane 
line-of-sight  angle,  and  R  the  range. 

The  startup  variances  for  all  runs  are 

°lx  =  °\y  =  trL  =  100  m2 
°2xx  =  ay>  =  <?]•  -  10  m2/s2 
a\A  =  0.1  mVs4 
a\,m  =  2.493241  x  10'6  s'2 

Appendix  B:  Derivation  of  Certainty  Control  Equations 

The  dot  terms  for  Eq.  (39)  are  computed  as  follows: 


Xj  -  lAxt;0  +  2Bji0  +  Cx 

(Bl) 

V/  =  3v4y  +  2 Bytgo  +  Cv—  A  Vy 

(B2) 

Zj  *  3 A.t\0  +  2 Bzti0  +  C--  A  yz 

(B3) 

Qxf  ~  3  A  +  2BaXt go  •+■  Cax 

(B4) 

Qyf  ~  3/4„y/|0  4-  2  Bgytgo  4-  Coy 

(B5) 

Ogj  =  4- 

(B6) 

The  Jacobian  matrix  elements  for  Eq.  (44)  are 

/  -VL-r 

(B7) 

,  Vi  «  *  a 

(B8) 

By,  -  y,t;0 

ax  (i  +  xrg20)2 

(B9) 

&Z/  ““  z3tgo 

ax  ~  (i  +  xr*0>2 

(B10) 

3f,o 

=  iyx,  +  Xj  +  y,y,  +  y}  +  i,z,  +  z} 

-  K\ox)dxj  +  o\,  +  <Syjoyj  +  d\i  +  a.fo.f  +  <x  Jy] 

(BID 

Xj  ~  6A,xt,0  -f  2 Bx 

(B12) 

y,  -  6A  j,0  +  28,  -  \<Sft,o  +  y,) 

(B13) 

Zf  =  6A.J,0  +  28- -  Mi/ito  +  zf) 

(B14) 

<ty  -  6-4„/,0  +  2  B„ 

(B15) 

o,/  =  Ms/,,,  +  2 B„ 

(B16) 

d.j  -  6A,;tto  +  2 B„ 

(B17) 

Ju  * 

3/;  dy,  .  .  dy,  3z,  -  .  31, 

ax  ax y’  y{  ax  ax  ’  1  ax 

(B18) 

3j h  y,f,c 

ax  ”  (i  +  x/2„)2 

(B19) 

Bi,  z,t, 0 

ax  ”  (1  +  x/20)2 

(B20) 

References 

'Guelman,  M.,  “Qualitative  Study  of  Proportional  Navigation,” 
IEEE  Transactions  on  Aerospace  and  Electronic  Systems,  Vol.  AES- 


7,  No.  4.  1971,  pp.  337-343. 

2Guelman,  M.,  "The  Closed  Form  Solution  of  Pure  Proportional 
Navigation,"  IEEE  Transactions  on  Aerospace  and  Electronic  Sys¬ 
tems,  Vol.  AES-12,  No.  4,  1976,  pp.  472-482. 

3Sridhar.  B.,  and  Gupta,  N.  K..  “Missile  Guidance  Laws  Based  on 
Singular  Perturbation  Methodology,"  Journal  of  Guidance  and  Con¬ 
trol,  Vol.  3,  April  1980,  pp.  158-166. 

*Tse,  E.,  Bar-Shalom.  Y.,  and  Meier,  L.,  Ill,  “Wide  Sense  Adap¬ 
tive  Dual  Control  for  Nonlinear  Stochastic  Systems,”  IEEE  Transac¬ 
tions  on  Automatic  Control,  Vol.  AC-18,  No.  2,  1973,  pp.  98-108. 

sTse,  E.,  and  Bar-Shalom,  Y..  "Adaptive  Dual  Control  for 
Stochastic  Nonlinear  Systems  with  Free  End-Time,"  IEEE  Transac¬ 
tions  on  Automatic  Control,  Oct,  1975,  pp.  670-675. 

6Nesline,  F.  W.,  Wells,  B.  H.,  and  Zachran,  P.,  "Combined  Opti¬ 
mal/Classic  Approach  to  Robust  Missile  Autopilot  Design,”  Journal 
of  Guidance  and  Control,  Vol.  4,  No.  3,  1981,  pp.  316-322. 

7Spcycr,  J.  L.,  Hull,  D.  G.,  and  Tseng,  C.  Y.,  “Estimation  En¬ 
hancement  by  Trajectory  Modulation  for  Homing  Missiles,”  Journal 
of  Guidance,  Control,  and  Dynamics,  Vol.  7,  No.  2,  1984,  pp. 
167-174. 

*Guelman.  M.,  and  Shinar,  J.,  "Optimal  Guidance  Law  in  the 
Plane."  Journal  of  Guidance,  Control ,  and  Dynamics,  Vol.  7,  No.  4, 
1984,  pp.  471-476. 

’Tang,  Y.  M.,  and  Borrie,  J.  A.,  “Missile  Guidance  Based  on 
Kalman  Filter  Estimation  of  Target  Maneuver,"  IEEE  Transactions 
on  Aerospace  and  Electronic  Systems,  Vol.  AES-20,  No.  6,  1984,  pp. 
736-741. 

10Yeuh,  W.  R.,  and  Lin,  C.  F.,  “Optimal  Controller  for  Homing 
Missile,”  Journal  of  Guidance,  Control,  and  Dynamics,  Vol.  8,  No. 
3,  1985,  pp.  408-411. 

"Lin,  C.  F.,  and  Lee,  S.  P.,  "Robust  Missile  Autopilot  Design 
Using  a  Generalized  Singular  Optimal  Control  Technique,"  Journal 
of  Guidance,  Control,  and  Dynamics,  Vol.  8,  No.  4,  1985.  pp. 
498-507. 

12Ashida,  S.,  Howe,  R.  M.,  and  Vinh,  N.  X.,  “Optimal  Control  of 
Air-Launched  Homing  Missiles  Based  on  Realistic  Performance  In¬ 
dices,"  Proceedings  of  the  Conference  on  Aerospace  Simulation  II, 
Vol.  16,  No.  2,  1986.  pp.  179-186. 

"Lin,  C.  F.,  and  Tsai,  L.  L.,  "Analytical  Solution  of  Optimal 
Trajectory-Shaping  Guidance,"  Journal  of  Guidance,  Control,  and 
Dynamics,  Vol.  10,  No.  1,  1987,  pp.  61-66. 

"Yang,  C.  D.,  and  Yeh,  F.  B.,  "Closed-Form  Solution  for  a  Class 
of  Guidance  Laws,"  Journal  of  Guidance,  Control,  and  Dynamics, 
Vol.  10,  No.  4,  1987,  pp.  412-415. 

"Cherry,  G.  W„  “A  General,  Explicit.  Optimizing  Guidance  Law 
for  Rocket-Propelled  Spaceflight,”  A1AA  Paper  64-638,  Aug.  1964. 

"Johnson,  F.  T.,  "Approximate  Finite-Thrust  Trajectory  Opti¬ 
mization,"  A1AA  Journal,  Vol.  7,  No.  6,  1969.  pp.  993-997 . 

"Bate,  R.  R.,  Mueller,  D.  C.,  and  White,  J.  E.,  Fundamentals  of 
Astrodynamics,  Dover,  New  York,  1971. 

"Borisenko,  1.  1.,  and  Kulvabichev,  Y.  P.,  "Algorithm  for  Opti¬ 
mization  of  the  Solution  of  the  Spacecraft  Rendezvous  Problem,” 
Cosmic  Research,  Vol.  18,  No.  3,  1980,  pp.  343-347. 

1 ’Stuart,  D.  G.,  “A  Simple  Targeting  Technique  for  Two-Body 
Spacecraft  Trajectories,”  Journal  of  Guidance,  Control,  and  Dynam¬ 
ics.  Vol.  9,  No.  1,  1986,  pp.  27-31. 

20Bhat,  M.  S.,  and  Shrivastava,  S.  K.,  “An  Optimal  Q-Guidance 
Scheme  for  Satellite  Launch  Vehicles,"  Journal  of  Guidance,  Con¬ 
trol,  and  Dynamics,  Vol.  10,  No.  1,  1987.  pp.  53-60. 

21Menon,  P.  K.  A.,  and  Calise,  A.  J.,  "Interception,  Evasion, 
Rendezvous  and  Velocity-to-Be-Gained  Guidance  for  Spacecraft,” 
AIAA  Paper  87-2318,  Aug.  1987. 

■^Dickmanns,  F.  D..  and  Wells,  K.  H.,  "Approximate  Solution  of 
Optimal  Control  Problems  Using  Third  Order  Hermtte  Polynomial 
Functions,"  Proceedings  of  the  6th  Technical  Conference  on  Opti¬ 
mization  Techniques.  Springer-Verlag,  New  York,  1975. 

23Hargraves,  C.  R.,  and  Paris,  S.  W.,  "Direct  Trajectory  Optimiza¬ 
tion  Using  Nonlinear  Programming  and  Collocation,"  Journal  of 
Guidance,  Control,  and  Dynamics,  Vol.  10,  No.  4,  1987.  pp.  338-342. 

:'Maron,  M.  J.,  A umerical  Analysis :  A  Practical  Approoch, 
Macmillan,  New  York.  1982,  pp.  177-182. 

:iBrvson,  A.  E.,  and  Ho.  Y.  C.,  Applied  Optimal  Control,  Hemi¬ 
sphere.  Washington,  DC,  1975,  pp.  71-75. 

2bGelb,  A.,  Applied  Optimal  Estimation.  Massachusetts  Institute  of 
Technology  Press,  Cambridge,  MA,  1986,  pp.  180-228. 

27Ho,  Y.  C..  "On  the  Stochastic  Approximation  Method  and  Opti¬ 
mal  Filtering  Theory,"  Journal  of  Mathematical  Analysts  and  Appli¬ 
cations,  Vol.  6,  1963,  pp.  152  154. 

2,Lenmann,  G.,  Optimization  Techniques,  Academic.  New  York, 
1962,  pp.  353-357. 


